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Рассматриваются проблемы разработки малогабаритных, быстродействующих, дешевых систем ориентации ( СО). Представле- 
на схема СО, построенная на основе двухкомпонентного микромеханического датчика угловой скорости. Рассмотрен принцип 
действия СО, проведен анализ динамики азимутального канала СО. Приведены результаты компьютерного моделирования ази- 
мутального канала СО. 


Разработка перспективных систем ориентации 
(СО), навигации и управления движением объек- 
тов различного назначения связана с их миниатю- 
ризацией, снижением стоимости, энергопотребле- 
ния и эксплуатационных расходов. 

Применение новых типов гироскопов, такие 
как лазерные, волоконно-оптические, твердотель- 
ные позволяют уменьшить массогабаритные харак- 
теристики СО, но стоимость их не уменьшается, а 
чаще всего увеличивается, что является основным 
препятствием их применения. 

Одним из перспективных направлений разви- 
тия гироскопического приборостроения является 
разработка микромеханических инерциальных 
датчиков, в которых используются новые конст- 
рукционные материалы и технологии микромеха- 
ники [2, 3]. Такие датчики имеют малые габариты, 
стоимость и энергопотребление. 


В работе рассматривается СО, построенная на 
микромеханическом инерциальном датчике. 

СО решают задачу определения положения раз- 
личных устройств и движущихся объектов относи- 
тельно заданных базовых направлений. При ори- 
ентации в околоземном пространстве базовыми яв- 
ляются: 

- направление полуденной линии; 

- направление местной вертикали. 

В качестве опорной системы координат (СК) 
наиболее часто используют географически ориен- 
тированную систему координат О^цС, (рис. 1), на- 
чало которой связано с объектом и перемещается 
вместе с ним. Оси Ос и Оц лежат в плоскости гори- 
зонта, ось Ос направлена по касательной к мери- 
диану на север, ось 0^ направлена по вертикали в 
зенит, ось О г) - на запад. Вектор О, угловой скорос- 
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ти вращения Земли раскладывается на две ортого- 
нальные составляющие 

СІ г -С1^-С1 3 со8(р; П в = П, = Г2 3 8Іп<р , 

где <р, X - географическая широта и долгота места 
нахождения объекта. 

Ориентация объекта относительно опорной 
системы координат (СК.) (рис. 2) определяется уг- 
лами: а, у, 8, где а - азимут объекта; у, 8 - углы 
отклонения объекта от плоскости горизонта, 
ОХ «У «2 к - система координат, жестко связанная с 
объектом. 



Рис. 1. Земная система координат, ориентированная геогра- 
фически 



Рис. 2. Системы координат, определяющая ориентацию 
объекта 

В рассматриваемой СО можно выделить два са- 
мостоятельных канала: 

- азимутальный, измеряющий азимут а объекта 
(канал компасирования), 

- горизонтальный, измеряющий углы у, й откло- 
нения объекта от плоскости горизонта. 

Горизонтальный канал реализован с помощью 
двухкоординатного физического маятника, осо- 
бенности работы которого достаточно полно отра- 


жены в литературе. В азимутальном канале реали- 
зован принцип аналитического компасирования, 
основанный на измерении проекций угловой ско- 
рости вращения Земли на оси чувствительного эле- 
мента и расчете азимута по этой информации. 

В работе рассматривается СО, построенная на 
микромеханическом инерциальном датчике. На рис. 
3 представлена принципиальная схема микромеха- 
нической СО, которая содержит двухосный маятник 

- 2, выполняющий функцию геометрического пост- 
роителя вертикали и установленный в кардановом 
подвесе - 3. На маятнике расположен чувствитель- 
ный элемент (ЧЭ) - 1 азимутального модуля, с кото- 
рого снимаются сигналы Э(?), используемые 
для определения азимутального угла а. 

На осях подвеса маятника установлены датчики 
угла - 4 и 5, с которых снимается информация об 
углах у(?), <5 (?) отклонения объекта от плоскости го- 
ризонта. 

Информация через аналого-цифровой преобра- 
зователь (АЦП) - 6 поступает в вычислительное 
устройство - 7, которое: 

- обеспечивает расчет углов ориентации а, у, 8 и 
географической широты ср; 

- обеспечивает фильтрацию сигналов; 

- определяет окончание переходного процесса 
колебаний маятника; 

- вырабатывает сигналы управления вибровозбу- 
дителя; 

- формирует сигналы управления системы резо- 
нансной настройки ЧЭ. 



Рис. 3. Принципиальная схема системы ориентации 


ЧЭ (рис. 4) азимутального канала СО содержит 
две инерционные массы -1,2, связанные с внут- 
ренней рамкой - 3 упругими элементами - 4. Виб- 
ропривод - 5 сообщает инерционным массам про- 
тивофазные поступательные колебания по закону 
Ц?) = дапет?. Внутренняя рамка - 3 связана упруги- 
ми элементами - 6 с наружной рамкой - 7, которая 
установлена в корпусе также с помощью упругих 
элементов - 8. ЧЭ не имеет маятниковости, то есть 
центр масс его совпадает с точкой пересечения 
осей подвеса. 
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Рис. 4. Принципиальная схема чувствительного элемента 
азимутального канала системы ориентации 


В результате вращения Земли и поступательных 
колебаний инерционных масс возникают силы Ко- 
риолиса, изменяющиеся по гармоническому зако- 
ну, что приводит к появлению угловых колебаний 
\| /(/), В(0 ЧЭ вокруг внутренней и наружной осей 
подвеса. 

Амплитуды этих колебаний измеряются датчи- 
ками - 9, 10, которые могут быть емкостными или 
пьезоэлектрическими, установленными в точках 
крепления упругих элементов - 6, 8. 

Для определения алгоритмов расчета азимута 
а составим уравнения движения ЧЭ азимутально- 
го модуля, которые имеют следующий вид 

І с \|> + Б ДО в + |д ;\д + с ]\|/ = 


имеют постоянную и переменную составляющие. 

Первые два уравнения характеризуют движение 
ЧЭ вокруг его осей подвеса, третье уравнение опре- 
деляет динамику вибропривода, который имеет 
достаточную мощность, поэтому члены второго по- 
рядка малости, через которые осуществляется его 
связь с угловым движением ЧЭ, не учитываются. 

Нелинейные члены в уравнениях (1) существен- 
но меньше линейных, поэтому для определения за- 
кона изменения координат \д(/), Д(/) воспользуемся 
методом последовательных приближений [1]. Ре- 
шение системы (1) находим в виде рядов, располо- 
женных по степеням малого параметра е 

Ѵ(0*Ч'о(0 + еч»і(0 + е 2 ч»2(0+- 

&(І) = До (І)т2&](0 + в*’й>{й + ... 

Общее решение ЧЭ азимутального модуля предс- 
тавляет собой колебания щ(і), 9,(1) вокруг его осей 
подвеса с частотой со вибровозбудителя, на которые 
накладываются более высокочастотные колебания 
і//і(/), 9\(1) ... с частотами, кратными частоте со. 

Амплитуды этих колебаний существенно мень- 
ше амплитуд основных информационных колеба- 
ний щ(1), 9,(1), которые определяются как 

\|/(1) = Асозсоі + Взіпсоі = \|/ 0 8Іп(со1 + ср,) 

Э{{) = Мсозсоі + №іпсо1 = ЧцЗІгфсоІ + ф 2 ), 
где амплитуды колебаний определяются как 


= -4т(6 + 2)2Г2 г со8СХ - 
-4т(і + г) 2 ІЮ в - 4т(Д + 2 ) 2 \д/ 

Э в О 1 — ВфО в -ь (Д^Ч + С 2 Ч — 

= -4т(6 + 2)гГ2 г 8Іпа + 

+4т(і + 2)2\|/Г2 в - 4т(/ + г)г&; 

пі 2 + Ѵ 2 + кг — N(1), (1) 

где обозначено 

9с = 9ѵ\ + 9 г + 4т(. 2 + 4 тЬ(1) = 

= 9у\ + 9 у + 4т[І + 2 (г)] • і; 

9 в = 9х + 4ті 2 + 4тіг([) = 

= 9 х +4 т[1 + ?(()]■ I 

И = -9 2 + 9 у + 9 х + 4т( 2 + 8т(г(і) , 

9х, 9у, 9 г - главные центральные моменты инерции 
инерционного тела; Щі) = /Ѵ 0 $іпй>? - сила, создава- 
емая вибровозбудителем; с ь с 2 - угловые жесткос- 
ти упругих элементов -6,8; ц ь ц 2 - коэффициенты 
сил вязкого трения; к - жесткость упругих элемен- 
тов - 4, обеспечивающих поступательные колеба- 
ния инерционных масс тп=т 1 =т\ 1=1і=1 2 расстоя- 
ние от центра масс ЧЭ до центров масс колеблю- 
щихся масс. 

Движение ЧЭ на неподвижном основании опи- 
сывается дифференциальными уравнениями с пе- 
риодическими коэффициентами, так как 9 С , / Л Д 


ц = М; я = М; М = N = ^1-, 

д д д д 

Д = (9ссо 2 -сі) 2 (9 всо 2 -сі) 2 - 
-2Н"со 2 (9ссо" —с\)(9всо" — с 2 ) + 

+ р 2 со 2 [(/ей) 2 - сі) 2 +(9вС0 2 -с 2 ) 2 ] + 
+ со 4 (Н 2 + р 2 ) 2 . 


А = 


(9с0)" -Сі) 2 (9вС0~ —Сі)" — 
-Н 2 аг(9ссо 2 -сі) + 

+ р~ со" (9 с<х>~ —сП) 

(9с(о" — С\)(9 всо" — сі) + 
+(9с(о с ) 

( 9 во. Г +С 2 ) 2 - 
-рсо 3 (Н 2 -р 2 ) 

Нсо(9ссо 2 - сі)(9в(о 2 -сг)- 
-Нсо 3 (Н 2 -р 2 ) 


Р\ соя а - 


±Нрсо 2 


В = -\рсо 
Д 


Р\ 8 іи а 


Р\ С08 а - 


Рі зіпа, 


м = 4- 


Н ро) 2 (9ссо 2 — Сі) х 
х(Увю 2 -сі) + (9с со 2 - сП) 
(9с(о~ — с\)(9 всо" — сі) — 
(9ссо" — Сі) + 

+р"со" (9 вСО" — сі) 


- Н 2 со 2 


Рі соза + 


Рі зіпа, 
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А = ф 


Н собеса 2 -сі)х 
х(ЛйГ-С2)-й> 2 (Я 2 -уг) 


Рі сов а - 


-1[ра)(Усй) 2 -о) 2 - со 2 (Н 2 + /і 2 )]а зіпа, 


( 2 ) 


<Рі, ср 2 - сдвиги фаз между колебаниями вибропри- 
вода и ЧЭ. 

Кроме того, имеются смещения у/ с , <9 С положе- 
ния динамического равновесия колебаний ЧЭ на 
постоянные величины, что обусловлено наличием 
нелинейных членов в уравнениях (1) 

_ 2т(г 0 ш(2()иА + (О в 1Ч -г^^оза) 

ЧА ~~ > 

с і 

_ 2т^2 0 со(2 АоВ + Ш В М - 2 рВІпа) 

Э с ■ 

с 2 


Как видно из выражений (2), информация об 
азимуте объекта содержится в амплитудах А, В, М, 
N колебаний ЧЭ с частотой со, все остальные сигна- 
лы являются помехами. Силы Кориолиса, вызыва- 
ющие колебания ЧЭ вокруг его осей подвеса, малы, 
соответственно малы и амплитуды колебаний ЧЭ. 
Для их увеличения необходимо осуществлять резо- 
нансную настройку системы, то есть параметры ЧЭ 
выбираются таким образом, чтобы все собственные 
частоты ЧЭ были равны между собой и равны час- 
тоте со вибровозбуждения инерционных масс. 

При выполнении резонансной настройки ази- 
мут можно рассчитать по выражению 


а р = лк ± агсГ§ 


цЭр-Яур 

ЯД 0 + |д\|/ 0 


где к= 0, 1, 2 определяется в зависимости от величи- 
ны фазового сдвига между колебаниями ЧЭ вокруг 
его осей подвеса. 

На рис. 5, 6 представлены результаты компью- 
терного моделирования движения ЧЭ в среде 
МаГЬЬаЪ. 

Высокая добротность колебательной системы 
может быть достигнута только при малой величине 
коэффициента сил вязкого трения, для чего осуще- 
ствляется вакуумирование ЧЭ. 

Однако, при уменьшении сил вязкого трения в 
ЧЭ возможно появление параметрического резо- 
нанса (рис. 5). Таким образом, существует крити- 
ческое значение коэффициента сил вязкого трения 
|і кр , при котором возникает неустойчивый режим. 
Увеличение демпфирования обеспечивает устой- 


чивые колебания ЧЭ, но приводит к уменьшению 
амплитуды полезного сигнала. 

Так как азимут рассчитывается по амплитудам 
колебаний ЧЭ с частотой со, то все остальные сиг- 
налы будут вызывать погрешности Да Р определе- 
ния азимута. Для их устранения используют поло- 
совые фильтры, настроенные на частоту со. На рис. 
6 видно, что на выходе полосовых фильтров оста- 
ются только полезные информационные сигналы 
\|/ 0 (1), Д 0 (1), по которым рассчитывается азимут а. 
Наличие АЦП приводит к появлению погрешнос- 
ти квантования Да и , которая уменьшается при 
увеличении разрядности АЦП. 


Ѵ(0 (град) 



Рис. 5. Параметрический резонанс ЧЭ 
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Рис. 6. Характеристики ЧЭ с АЦП с использованием полосо- 
вых фильтров и без них 

Таким образом, применение микромеханичес- 
кого ЧЭ позволяет получать время готовности при- 
бора доли или единицы секунд (рис. 6) при сверх- 
малых габаритах, низкой стоимости и достаточно 
высокой точности. 
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